int8 mode   # 0 means absolute position, 1 means increment position
uint16[6] angles   # angles of six joints